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SUMMARY 


The research sponsored by Goddard Space Flight Center (NASA) 
under the research grant entitled : " Active Control of Robot 

Manipulators" with grant No NAG 5-780, performed between July 1, 
1987 and December 31, 1987, is presented in this report. 

This report considers the problem of cartesian trajectory 
control of a closed-kinematic chain mechanism robot manipulator , 
recently built at CAIR to study the assembly of NASA hardware for 
the future space station. The study is performed by both 
computer simulation and experimentation for tracking of three 
different paths: a straight line, a sinusoid and a circle. 

Linearization and pole placement methods are employed to design 
controller gains. Results show that the controllers are robust 
and there are good agreements between simulation and 
experimentation. They also show excellent tracking quality and 


small overshoots . 


1 . INTRODUCTION 


The control problem of robot manipulators can be considered 
to consist of two coherent subproblems: trajectory planning and 

trajectory control. Based on the coordinate system used in 
planning and controlling the robot hand trajectory, control- 
schemes can be conveniently divided into two classes: joint 

space and cartesian space control schemes. In joint space control 
methods, the error actuating signal to the joint actuators is 
computed based on the error between the desired joint position 
and the actual joint position of the manipulator hand. On the 
other hand, the cartesian space-oriented methods use the error 
between the desired and actual cartesian position of the 
manipulator to compute the error actuating signal to the joint 
actuators [3] . While enjoying the simplicity in trajectory 
planning, the joint space-oriented method suffers from the 
difficulty in determining link locations of the robot hand 
during motion, a task requiring to ensure obstacle avoidance 
along the trajectory [3]. Furthermore, joint coordinates are not 
suitable as a working coordinate system because the joint axes of 
most manipulators are not orthogonal and they do not separate 
position from orientation [10] . The cartesian space-oriented 
approach whose path planning requires intensive computations for 
transformations between cartesian and joint coordinates in real 
time, has the advantage of assuring a certain degree of accuracy 
along the desired path and being more adaptable to the user. 

There has been numerous interest in developing cartesian 
space-oriented control schemes. Considering that paths are made 
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up by straight line segments, connected by smooth transition, 
Paul [10] and Taylor [15] proposed schemes that control the 
acceleration at the transition in order to achieve the desired 
cartesian path. Cartesian control of joint compliance 
manipulators was studied in [4] . The research in [6] and [17] 
shows that cartesian acceleration and force can be controlled 
successfully. Recently a closed-kinematic chain mechanism robot 
was built at NASA (Goddard Space Flight Center) to study the 
robotic assembly of NASA hardware for the future space station. 
This report presents part of the ongoing robotic research at CAIR 
for the control of the NASA robot. In particular, we consider the 
cartesian trajectory control of a small scale, manipulator with 2 
degrees of freedom, resembling part of the complete NASA robot. 
Controllers are designed through the linearization of the robot 
dynamics and pole placement methods. The tracking performance of 
the controller will then be studied by both simulation and 
experimentation for three different trajectories: a straight 
line, a sinusoid and a circle. This report is structured as 
follows. First we present the hardwares of the manipulator under 
study together with the development of its kinematic and dynamic 
equations. Then the linearization about an operating point is 
discussed in conjunction with the controller design through the 
pole placement method. Finally we report the results of computer 
simulation and experimental study and make comparative 
evaluations. 
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2. THE MANIPULATOR MODEL 


The main parts of the robot manipulator under study are 
presented in Fig. 1. It is a closed-kinematic chain mechanism 
manipulator with two degrees of freedom. Two links of the 
manipulator are composed of two ball-screw actuators, driven by 
two dc motors and hung below a fixed platform by means of pin 
joints. Two linear voltage differential transformers (LVDT) are 
mounted along the links to measure their lenghts. The other ends 
of the links are joined together by a pin joint on which a 
gripper is mounted. The gripper motion is expressed with respect 
to a reference x-y cartesian coordinate system attached to the 
fixed platform as seen. The cartesian variables x and y are 
related to the joint variables 1^ and I 2 » the link lenghts by 
[9] : 

x = <l x 2 - 1 2 2 + d 2 ) / (2d) (1) 

and y = -[4d 2 l 1 2 - U 2 2 - 1 2 2 + d 2 ) 2 ] 1/2 (2) 

where d is the distance between the pin joints hanging the 
actuators. 

The Lagrangian equation of motion of a robot manipulator is 
given by: 

F = M ( 1 ) 1 + H(l,l) + G ( 1 ) (3) 

where F is a vector of input forces acting on the manipulator and 
1 is a vector of joint variables. M(l), N(l,i) and G ( 1 ) represent 
the moment of inertia, the centrifugal and coriolis forces, and 
the gravity, respectively. Using Lagrangian approach, we derive 
the following equations of motions: 
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(4) 






F 1 * “l^l + C»il ro (l 2 " 1 l )/(3< 5 )3 ^2 + G 1 

F 2 = m x l 2 + [ffi 1 l m (l 1 -l 2 )/{3q)]i 1 + G 2 (5) 

where, ,G 2 ,and q are given by 

G 1 « |-m 1 g[2B 1 l 1 2 (l 1 l ln + l 2 l ffi + 21 1 1 2 ) - l 2 l ffi q 2 ] 

-mgl in t21 1 2 B 1 (l 1 + 1 2 ) - l 2 q 2 ] }/(4dl 1 2 l 2 q) (6) 

G 2 = Hm 1 g[2B 2 l 2 2 (l 1 l in + l 2 l m + 21 x 1 2 ) - l^q 2 ] 

-mgl m t21 2 2 B 2 (l 1 + 1 2 ) - l iq 2 ] )/(4dl 1 l 2 2 q) (7) 

q = [4d 2 l 1 2 - ( 1 x 2 - 1 2 2 + d 2 ) 3 1/2 (8) 

B x * 1 2 2 - lj 2 + d 2 (9) 

® 2 “ H 2 - 1 2 2 + d2 ( 10 ) 


where m 2 is the mass of the moving part of the link, m is the 
total mass of the link, and 1^ represents the fixed length of the 
actuators. Both actuators are assumed to be identical. In the 
derivation of the equations of motions the gripper is not 
included. 

The Jacobian relating joint variable velocities and i 2 to 
cartesian velocity variables x and y is given by 

l x /d -1 2 /d 

” 5 00 o 0'S (11) 

(ljd 2 + 1 1 1 2 2 - l^/tqd) (l 2 d 2 + 1 2 1^ 2 - l 2 3 )/(qd) 

The trajectory control scheme employed in this report is 
presented in Fig. 2 where cartesian position feedback is obtained 
through the forward kinematic transform [Eqs. (1) and (2)]. 
Actual velocity is obtained by differentiating the actual 
position, which is implemented by the data aquisition software. 
The errors of cartesian position and velocity are converted into 
corresponding joint variable errors by means of the inverse 
Jacobian matrix . The joint variable errors will then serve as 
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inputs to the PD controllers that in turn produce required forces 
for the actuators to track the robot gripper along a desired 
trajectory with a desired velocity profile. 


3. LINEARIZATION AND CONTROLLER DESIGN 

Since the dynamics of the manipulator is highly nonlinear, 
linearization about a selected operating point should be employed 
in order to design effective PD controllers. According to the 
work in [12], the linearization consists of expanding Eqs. (4) 
and (5) about a selected operating point using Taylor series 
expansion, neglecting higher order terms and transforming the 
resulting expression into a linear state equation given by: 



• 

z 

= Az + 

BF 

(12) 


W 

= Cz 


(13) 

where 

z 

= (li 

• * m 

1 2 1 1 1 2 ) 

(14) 

and 

w 

= <ll 

1 2 > T 

(15) 


The development of A, B, and C can be found in [12] . From 
Fig. 2 we can write 

F = P(v x - W) + D(v 2 - W) (16) 

where P and D are matrices that contain parameters for the P 
controllers and D controllers, respectively and are given by 


P = 

’ k pl 

0 

D = 

k dl 

0 


0 

k p2. 


0 

k d2_ 


The vector v^ and v 2 are command vectors expressing the desired 
joint variables and velocities, respectively. In addition, (v^ 
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W) and (v 2 -W) represent the joint variable error and joint 
variable velocity, respectively. Substituting (16) into (12) 
and employing (13), after some manipulation we obtain 


z 


(I + BDC) _1 (A - BPC) z + (I + BDC) -1 BQv 


(18) 


where 

Q 


P 0 


(19) 


L° DJ 

and v V 2^ T (20) 

From (18) it is obvious that the matrices P and D should be 
selected such that the eigenvalues of (I+BDC) ”* (A-BPC) are stable, 
which can be realized by several available methods of pole 
placement and softwares. Particularly the procedures proposed in 
[13] is recommended. Here we assume that the matrix (I+BDC) is 
nonsingular. 


• 4. SIMULATION AND EXPERIMENTAL STUDY 

In order to exam the performance of the cartesian control 
scheme illustrated in Fig. 2, we conducted both simulation and 

• experimental study for tracking of three different trajectories: 
a straight line, a sinusoid and a circle. In the simulation 
study, the entire control scheme including the manipulator 

• dynamics was simulated on an IBM/XT using the System Simulation 
Language (SYSL) . First PD controller gains were selected using 
the procedures discussed in Sect. 3 to ensure the system 
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stability. Then the obtained gains were adjusted for each of the 
above three tracking cases until a satisfactory tracking was 
achieved. According to the simulation results, the gain 
adjustments were within 10% of the original gains obtained from 
the linearization and pole placement methods. In the 
experimental study, the robot manipulator was interfaced with 
the IBM computer through a data acquisition system consisting of 
an IBM board, an adapter and a software called Labtech [7] . PD 
controllers, inverse Jacobian and the forward kinematic transform 
were implemented using Labtech. The gains obtained through the 
simulation study were applied to the real-time control of the 
robot manipulator. In. the following we will present the above 
study results and make comparative evaluations: 


Numerical Values : 

(a) Linearization about the home position {1^ = 83.80 cm, 
12 = 85.90 cm! : 


A 


0 0 10 

0 0 0 1 

-45.66 17.97 0 0 

_ 33.53 -48.34 0 0. 


B 



0 

0 

0 

1.7 


C = [1 0 0 ] 

0 1 0 oj 


(b) Controller Gains: k pl = 2400 N/m; k p2 =2600 N/m; k dl = 20 N.s/m; 
kd 2 = 20 N.s/m. 

(c) Robot Dynamics: m^ = 


.59 kg; m = 4.91 kg; d = .737 m. 



Tracking a straight line : 


In this study the robot is to track a desired straight line 
described by the equation y(t) = -x(t) - 42 cm with a desired 

velocity of 1.7cm/s. Figures 3 to 5 present the simulation and 
experimental results for this case. The simulated motion follows 
the target path very closely with a maximum deviation of 4mm. 
Experimental results show that the robot actually follows the 
desired path with an excellent tracking quality with some 
disturbances at the starting position. After reaching the steady 
state, the robot tracks the desired path very closely with a 
maximum deviation- of 3mm. The simulation and actual velocities in 
x and y directions are presented in Figures 6 and 7, 
respectively. As seen from these figures, both simulation and 
actual velocities lag behind the desired one. The simulation and 
actual velocities stay constantly at about 76% and 31% of the 
desired one, respectively. 


Tracking a sinusoid : 

The simulation and experimental results for tracking 
a sinusoidal trajectory described by the equation 
y = 2 . 5sin (2x-50) -82 . 5 cm with a desired constant velocity of 
1.7 cm/s are showed in Figure 8. The simulation motion follows 
the desired trajectory very closely with a constant deviation of 
3mm. Actual motion shows good tracking quality with some 
disturbances during the transient state. 


Tracking a circular path : 


In this case we study the performance of the robot in 
tracking a circular trajectory described by the equation 
(x-13 . 5) (y+33) ^=14 with a desired constant velocity of 1.7cm/s 
(Fig. 9) . Simulation motion agrees with the desired trajectory 
very closely with some insignificant shifting. Experimental 
results show that the actual motion of the robot resembles a 
circular path that is shifted to the left (horizontally) of the 
desired trajectory and is compressed vertically. The horizontal 
shifting and vertical compression are about 5mm and 3mm, 
respectively. 

Evaluations and discussions : 

The existence of the tracking errors in the above study 
cases can be clarified by the following reasons: 

(a) The employed software and the computer are not capable 
of performing fast computations and high sampling rates. Because 
the data acquisition system has been using a sampling rate of 3 
samples/sec, the feedback information provided by the position 
sensors (LVDT) cannot be updated quickly enough for the 
controller to act on the actuators. Thus the actual position of 
the robot cannot be updated timely, causing motion overshoots. 
The tracking quality can be improved tremendously if a data 
acquisition system with faster computation capability and higher 
sampling rate is employed. 

(b) As expected from most industrial and educational 



robots, our robot also suffers from some problems in machine 
design such as vibration, backlash, nonidentical actuators, and 
joint friction. These problems create tracking errors and can be 
remedied by improving the machine design or applying a more 
advanced control scheme such as adaptive control. 

5. CONCLUSION 

In this report we have considered the problem of cartesian 
trajectory control of a closed-kinematic chain mechanism robot 
manipulator with two degrees of freedom. Linearization and pole 
placement methods were employed to design the PD controller 
gains. The performance of the control scheme was examined by both 
simulation and experimentation. Study results showed good 
agreements between simulation and experimentation. They also 
showed that appropriate adjustments of controller gains designed 
from a linearized model of a robot manipulator enables one to 
design effective controllers for this manipulator. Since the 
linearized model is only valid in the neighborhood of a selected 
operating point, the tracking can be improved if there exists a 
scheme to update the controller gains by updating the linearized 
model as the manipulator moves along the path. Our current 
active research is focused on the analysis and implementation of 
several control schemes to control force and position of the end 
effector simultaneously. Control algorithms such as hybrid, 
modified hybrid and adaptive control scheme will be tested on the 
above robot manipulator to find the optimal control algorithm. 
Then the results of the two-degree-of-f reedom robot manipulator 
will be applied to control the six-degree-of-f reedom NASA robot. 
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The closed-kinematic chain mechanism robot manipulator 
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